Arduino – Ultra Sonic – LED 8
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 |
#define trigPin 2 #define echoPin 3 #define CNT 10 long distances=0; int cnt=0; int numbers=0; long vars[CNT]={0,}; int leds[]={6,7,8,9,10,11,12,13}; void setup() { pinMode(trigPin, OUTPUT); pinMode(echoPin, INPUT); Serial.begin(9600); for (int i=0;i<8;i++) { pinMode(leds[i], OUTPUT); } } void loop() { digitalWrite(trigPin, LOW); delayMicroseconds(2); digitalWrite(trigPin, HIGH); delayMicroseconds(10); digitalWrite(trigPin, LOW); distances=(pulseIn(echoPin, HIGH) / 29.0) / 2; if (cnt < CNT) { if (distances < 500) { vars[cnt]=distances; cnt++; } } else { distances=averageDis(); cnt=0; if (distances > 200) { numbers=7; } else if (distances < 5) { numbers=0; } else { numbers=map(distances, 5, 200, 0, 7); } Serial.print("numbers : "); Serial.print(numbers); Serial.print(", distances : "); Serial.println(distances); } for (int i=0;i<8;i++) { if (i <= numbers) { digitalWrite(leds[i], HIGH); } else { digitalWrite(leds[i], LOW); } } } long averageDis() { long temp; long sum=0; for (int i=0;i<CNT-1;i++) { for (int j=i+1;j<CNT;j++) { if (vars[i] > vars[j]) { temp=vars[i]; vars[i]=vars[j]; vars[j]=temp; } } } for (int i=1;i<CNT-1;i++) { sum+=vars[i]; } return sum/(CNT-2); } |